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Brainstem Prograiraning Code - Figure le. 

#include <aCore.tea> 
#include <aGP.tea> 
#include <aCompass. tea> 

void initO 
{ 

/* switch to internal heartbeat */ 

/* otherwise terminal program will receive heartbeats 

asm 

{ 

pushlb 1 

popbm aPortHBMode 

} 

} 

void aDump IntDec{int n) 
{ 

asm 
{ 

pushss 4 
fmtsd 

popbm aPortSerialNTX 

} 

} 

void aDump CharDec(char c) 

{ 

asm 
{ 

pushsb 3 
fmtbd 

popbm aPortSerialNTX 

} 

} 

void aDump Char (char c) 
{ 

asm 
{ 

pushsb 3 
pushlb 1 

popbm aPortSerialNTX 

} 

} 

void aDump String (string s) 
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asm { 

pushsb 3 
next : 

brz end 
pushsb 1 
pushlb 4 
addb 
pushsbx 
pushlb 1 

popbm aPortSerialNTX 
decb 1 
goto next 

end: 

popb 

} 

} 

void main ( ) 
{ 

int i = 0; 
int X = 0; 
int y = 0; 
int j = 0; 

init 0 ; 



/* waits about 9 seconds */ 

/* to provide time to close Console and launch terminal 

aCore Sleep (30000) ; 

aCore Sleep (30000) ; 

aCore Sleep (30000) ; 

while (1) 

{ 

X = aGP ReadGP2D02 0 ; 
aCore Sleep (10000) ; 
aDiamp String ("R: ") ; 
aDump IntDec(x); 
aDump String ( " " ) ; 

j = aCompass ReadlntO; 
aCore Sleep (10000) ; 
aDump String (" H: ") ; 
aDump Int Dec (j / (int) 10); 
y = j / 10; 

if(y==359) aDump String ("-N -"); 

else if(y==0 I I y==l) aDump String("-N") ; 
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else if(y>l «<& y<89) aDump_String ("-NE") ; 
else if{y>88 && y<92) aDump_String ( "-E" ) ; 
else if(y>91 && y<179) aDump_String ( "-SE" ) ; 
else if(y>178 && y<182) aDump_String { "-S" ) ; 
else if{y>181 && y<269) aDump_String ( "-SW") ; 
else if(y>268 && y<272) aDump_String ( "-W" ) ; 
else if(y>271 && y<359) aDump_String ( "-NW") ; 
aDump_String ( " ~ " ) ; 
aDump_Char ( 13 ) ; 
aDump_Char ( 10 ) ; 

aDump_String ( " \n" ) ; 
aCore_Sleep(2500) ; 

} 

} 



